#!/usr/bin/env python3

import rospy
from DrRobotController_six_axes_can.msg import read_joint_motor_property
# import DrRobotController_six_axes as dr

def callback(data):
    import DrRobotController_six_axes as dr
    value = dr.read_joint_motor_property(id_num=data.id_num, joint_num=data.joint_num,property=data.property)
    rospy.loginfo("read_joint_motor_property_node: %f" , value)


def listener():
    rospy.init_node("read_joint_motor_property", anonymous=True)
    rospy.Subscriber("read_joint_motor_property", read_joint_motor_property, callback)
    rospy.spin()


if __name__ == '__main__':
    listener()

